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The Segway Human Transport (HT) robot, it is dynamical self-balancing 
robot type. The stability control is an important thing for the Segway robot. 
It is an indisputable fact that Segway robot is a natural instability framework 
robot. The case study of the Segway robot focuses on running balance 
control systems. The roll, pitch, and yaw balance of this robot are obtained 
by estimating the Kalman Filter with a combination of the pole placement 
and the Linear Quadratic Regulator (LQR) control method. In our system 
configuration, the mathematical model of the robot will be proved by Matlab 
Simulink by modelling of the stabilizing control system of all state variable 
input. Furthermore, the implementation of this system modelled to 
the real-time test of the Segway robot. The expected result is by substitute 
the known parameters from Gyro, Accelero and both rotary encoder to initial 
stabilize control function, the system will respond to the zero input curve. 
The coordinate units of displacement response and inclination response 


pictures are the same. As our expected, the response of the system can reach 
the zero point position. 
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1. INTRODUCTION 

A demand to increase the abilities of a user-friendly robot system has increased to overcome 
difficulties of controlling robots especially for interaction between human beings and personal care robots. 
One example of the personal care robot is Segway Human Transport (HT), it is dynamical self-balancing 
robot type. Segway platforms are implementing human/robot coordination in the unknown environment 
through the floor, road, field, etc. Full review in recent years, relating to control variables, control algorithm 
and some application of the Segway. Segway has three states of control; without input coupling, reaction wheel, 
and input coupling. In our research, we selected an element of the state control without input coupling. 

In this state control, some control methods are already implemented such as PID [1] to advanced 
methods of the sliding mode control, adaptive control [2, 3], neural network [4, 5], robust control [6], 
back-stepping, LQR [7], observer [8, 9], pole placement [10] hybrid control [11], and fuzzy inference system 
based control [12, 13]. There still have an unsolved challenging control problem between the control variable 
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(pendulum) and reaction wheel [14-16]. So that effective control needs to be applied so that the system 
makes it stable during work [17-19]. In this research, system configuration and Segway mathematical models 
are explained using Matlab Simulink. 

Among this system configuration, operating the Segway using differences between the angle 
of the initial position and last angle of the pendulum, and the stability of system have wheels factors (actuator 
specification and wheels diameter) [20]. The problems are considered as unknown disturbance 
and the operator condition has to keep balancing on it in the first type of task. On the contrary, the active 
movement of the operator is utilized as an interface to intuitively drive the Segway in the second type 
of task [21-22]. Based on this problem, we use stabilize algorithm to minimize errors from some variables 
above and improve the performance of the Segway. The motivation and challenge for my research 
are optimism of continuing increases in effectiveness and reliability of controlling the Segway robot by using 
our control stabilize method. 

To support this, researchers have developed various control methods have been proposed from 
the classic PID method to sophisticated methods such as sliding mode control, adaptive control, strong 
control, back-stepping, and fuzzy inference-based control systems. There is already an important application 
of the two-wheeled mobile robot (TWMR), for example, Segway, TWMR based cars and E-scooter. 
Some system also uses the global position to support regulating the angular momentum around it 
are considered as primary objectives, stabilizing the posture to make the Segway working smoothly [23]. 

Based on several types of research above, it is possible to develop new stabilize control method 
of the Segway, by proving system stability can be controlled and the system is also anti-external interference. 
If there is interference given to the system, the system will remain stable if the angle of interference provided 
is still within limits., these our purpose of this experimental design of the Segway robot the system regulate 
set to the zero point position. Next section will explain about the related work about the Segway robot. 


2. RELATED WORKS 

The Segway robot system has been conducted involving human-robot support system [24], where 
a pendulum system is the main input control of the robot. These Segway systems have three degrees 
of freedom (DoF); the rotation of inverted pendulum, forward and backward movement of the chassis as well 
as the rotational movement the chassis. The first model of the Segway has been developed, it has the inverted 
pendulum system and the rotational movement [25]. By using two state feedback controller by pole 
assignment method of this system, it makes the Segway stable and able to reduce force and angular 
disturbance from the rotational movement of the inverted pendulum. Another researcher also develops 
the new version of the Segway with input coupling systems [26]. The DC motor as an actuator is mounted on 
the pendulum so that the torque from the motor is given directly to the system: on the pendulum and both wheels. 

The segway robot model is similar to the previous model, but there are additional wheels in 
the system to maintain the stability of the pendulum. The pendulum is kept stable in a vertical position with 
a PID controller. In addition, the Fuzzy Mamdani model has also been used to control this system [27]. 
Adaptive control is carried out in [28] to make this two-wheeled robot reach the desired setpoint. The use 
of state transformation with the Lyapunov approach in adaptive control is also often used [29]. Problems with 
the control method to reach the setpoint in this system, namely the location and balance of this nonlinear 
control, can also be solved by a combination of fuzzy logic control and sliding mode control. 

Of the various methods that have been used to control the balance on a Segway, there are limitations 
to factors such as control ability, segway with input coupling, uneven track surface, and many others. 
Some system failure factors such as dead batteries and if one of the two actuators fails to work also have not 
been taken into account for the safety of some segway models. The purpose of this work is to mathematically 
model the segway system, design the appropriate control method for this system, and its application. 
Our experimental design will explain in section three. 


3. RESEARCH METHOD 
3.1. Mathematical model 

The Segway Robot consists of two wheels, which are controlled by a DC motor and an inverted 
pendulum in the center of the chassis. It is given that when the robot moves, the chassis rotates passively 
around the axis of the wheels. The pendulum also rotates passively in the center of the chassis that places 
between two wheels. One variable as state input control task of the robot is to maintain the position 
of the pendulum around the vertical equilibrium point of the chassis. It means that the angle between 
the pendulum and the vertical axis is mostly zero degrees even the operator was stand in the robot. 
The second variable is the set point condition. Segway is expected to reach the desired position along 
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a Straight line with any starting position. And the third variable is tracking control variable, it means that 
the Segway robot keep movement to closely line the desired trajectory. 

The movement of this robot has 3 directions, namely the movement of the robot on the X-axis, 
the wheel shaft as the Y-axis, the pendulum is perpendicular to the Z-axis, and suppose that the robot's mass 
is located or concentrated at point g. Figure 1 shows the segway model. Figure | shows a system that has 3 
degrees of freedom (DOF), namely the movement on the X-axis (Roll) that moves on the X-axis with speed 
V, the winding movement on the Y-axis (Pitch) with angle with angular velocity œ (mg), and rotary motion 
on the Z (Yaw) axis with angle ọ and angular velocity  B. The x-axis, the velocity V, the angle, the angular 
velocity œ, the angle ọ, and the angular velocity B B are 6 space variable variables that describe the dynamic 
characteristics of this system. It is assumed that the external disturbance that occurs in this system is located 
at point g. 





Figure 1. Model of segway 


3.2. Experimental design 

Products which are presented from the mathematic model is linearizing the nonlinear around 
the vertical equilibrium point of the chassis. 

XM =0,VM = 0,6P = 0,0Y =0 

The system can be written in the state-space form: 

X = AX + Bu 


Where, X denotes the state vector, u are input torques on the left and right wheel. 


X = [XM; VM; 0P; !P; 0Y; ! Y]? 
u = [CL; Cr]? 


We assume that mass of the whole body and the motor as m notation, R is the radius of the wheels 
and height of the pendulum above the wheel axel given by L as well as the gravity g. Then we can calculate 
the moment inertia variable both the chassis body and total moment inertia effective. To calculate 
the effective total moment of inertia (Jeff) = inertia of the chassis body + wheels inertia + pendulum inertia 


Jeff =]+m*R*L+m>*L*L 


Now the variable A and B given: 


010 0 
a= |S 0 0 Aeff 
000 1 
0 0 0 —1/T 


B=[0 BJeff 0 BVelļļf 
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By calculate form state-input variable, so the matrix A given: 


0 0 
m*g*L a 0 m*R*L 
DE 0 — 
A=| Jeff 9 o Teff 
o ua 1 
0 —1/T 


After calculating the motor DC velocity as state input, B given: 


—m * R x L x Kdc Kde 


Where Kdc is the gain of motor DC velocity. Then the stability control of the Segway. 
SC = (A, [BG], C, [DH]) 


Where G is equal B that means process disturbance assumed to come in as an error in the motor drive and H 
is the process disturbance does not directly affect outputs. If we implemented process noise (motor drive 
error) given by QN and measurement noise from excel, then gyro then motor encoder, again this is expected 
the value of noise squared given by RN. Then the stability control total by using the Kalman filter method is 


SCeff = kalman(SC, QN, RN) 
Next section will explain about Matlab Simulink model of this mathematical equation. 


3.3. Matlab simulink design 

The two-wheeled inverted pendulum has been very often discussed by some literature as 
an application of the control method. Common parameters to be controlled on a conventional pendulum are x 
and 0. In this work, the control system that is controlled is yaw ọ and speed œ. It is hoped that this system can 
function as a safe human carrier by linearizing the mathematical model of the system. Even so, there 
are some nonlinear terms that cannot be easy because the required assumptions are not fulfilled. Figure 2 
shows the control design, where the controller is using the Kalman Filter with LQR and pole placement, 
and the plant is a two-wheeled robot. 





Controller 








Figure 2. Control design 


It is given that four state input variable of the system can be measured by Accelerometer, Gyroscope 
and two rotary encoders from both left and right motors. This means that the Simulink design can be used as 
an observer of full-dimensional state input variables. These four state variable will be processed by Kalman 
state estimator to estimate the value X and Y. These Kalman state estimator matrices and full state feedback 
gains as designed by LQR or pole placement as shown in Figure 3. 

The results from the above simulations show that state feedback has gained, and the arithmetic 
control program is written in another Matlab script. So that the testing of the prototype in real-time conditions 
can be tested. The feedback gain on the state feedback control can be adjusted constantly. This gain 
adjustment is adjusted for errors in modeling and the realtime state, the death district in the DC motor, 
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the sensor state, and so on. This gain adjustment is carried out to get the desired response. The variable of 
encoder and gyroscope shown in Figure 4. 







theta_dot 





phi_dot 





get_states Bus to Vector 





Scope 


Figure 3. Control variable of the LQR 


L" y 





Model2 Real_out 
MATLAB Function 


Figure 4. Variable of encoder and gyro 


4. RESULTS AND ANALYSIS 

Our expectation by substitute the known parameters from the gyro, accelero and both rotary encoder 
to initial SCeff = Kalman(SC, QN, RN) function, Figure 5 shows the response of the system with zero 
setpoint. It can be seen that the system response can reach the setpoint at zero as desired. Simulations 
with Matlab are used to design state-controller feedback based on linear systematic theory and implementing 
this controller to the real Segway robot. After the simulation results are effective then we will move to 
the real-time test both show that control and modeling are designed from this system, our expected of it can 
be reasonable and effective for the Segway robot. 
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Figure 5. Real-time result 
CONCLUSION 
The control system for a two-wheeled robot balance has been successfully applied in this paper. 


The proposed optimal controller for the non-linear system of the two wheels robot obtains the response with 
a great performance. The controller makes the balance between speed response and control angle position 
condition as well. The faster response achieved in unstable condition between speed and angle of the two 
wheels robot. For this condition, Kalman filter and 7-stages control system adjusted. To analyze the effects 
of interference, the result in Figure. 5 between displacement response and an inclination response system 
response curves of Zero Input that indicates the rejection of disturbance applied at with optimal controller. 
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